' SumoBot_2.1_Motor_Align.BS2
' {$STAMP BS2}
' {$PBASIC 2.5}

' -----[ I/O Definitions ]-----------------------------------

LMotor          PIN     13        ' left servo motor
RMotor          PIN     12        ' right servo motor

' -----[ Constants ]------------------------------------------

LStop           CON     750       ' left motor stop
RStop           CON     750       ' right motor stop

' -----[ Initialization ]-------------------------------------

Reset:
  LOW LMotor                      ' initialize motor outputs
  LOW RMotor

' -----[ Program Code ]---------------------------------------

Main:
  DO
    PULSOUT LMotor, LStop          ' stop left
    PULSOUT RMotor, RStop          ' stop right
    PAUSE 20
  LOOP

  END